Optimal Attitude Control for a Rigid Body with Symmetry 
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Abstract — Optimal control problems are formulated and 
efficient computational procedures are proposed for attitude 
dynamics of a rigid body with symmetry. The rigid body is 
assumed to act under a gravitational potential and under a 
structured control moment that respects the symmetry. The 
symmetry in the attitude dynamics system yields a conserved 
quantity, and it causes a fundamental singularity in the optimal 
control problem. The key feature of this paper is its use of 
computational procedures that are guaranteed to avoid the 
numerical ill-conditioning that originates from this symmetry. 
It also preserves the geometry of the attitude dynamics. The 
theoretical basis for the computational procedures is summa- 
rized, and examples of optimal attitude maneuvers for a 3D 
pendulum are presented. 

I. Introduction 

We study a discrete optimal control problem for attitude 
dynamics of a rigid body with symmetry. The attitude is 
represented by a rotation matrix, which has a Lie group 
structure denoted by SO (3). We assume that the rigid body 
is acting under an attitude dependent potential, and the 
potential is invariant under a symmetry action. The external 
control input is formulated such that it respects the symmetry. 
This problem provides both a theoretical challenge and a 
numerical challenge in the sense that the configuration space 
has a Lie group structure, and the conserved quantity causes 
ill-conditioning of the numerical optimization. 

General purpose numerical integration methods, including 
the popular Runge-Kutta schemes, typically preserve neither 
the group structure of the attitude configuration space nor the 
invariant properties of the dynamics. Geometric structure- 
preserving integrators are symplectic and momentum pre- 
serving, and they exhibit good energy behavior for an ex- 
ponentially long time period [1]. In particular, Lie group 
variational integrators have the desirable properties that they 
preserve the group structure as well as the geometric fea- 
tures, without needs of local parameterization, reprojection, 
or constraints [2], [3]. The exact geometric properties of 
the discrete flow not only generate improved qualitative 
behavior, but also allow for accurate long-time simulation. 

Optimal control problems on a Lie group have been 
studied in [4], [5], [6]. These studies are based on the driftless 
kinematics of a Lie group. The dynamics are ignored, and 
elements in the corresponding Lie algebra are considered as 
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control inputs. The discrete optimal control problems of a 
rigid body are studied in [7], [8], where the dynamics as 
well as the kinematics equations are explicitly utilized, and 
an efficient numerical algorithm to solve discrete optimality 
conditions is presented. 

This paper introduces geometrically exact and numerically 
efficient computational approaches to solve the optimal con- 
trol problems of the attitude dynamics of a rigid body with 
symmetry and structured control input. The dynamics are 
discretized by a Lie group variational integrator, and discrete 
necessary conditions for optimality are constructed. The 
utilization of the Lie group variational integrator is justified 
in this problem, since it preserves the momentum map orig- 
inating from the symmetry. The rigid body is underactuated 
since the control input does not act along the symmetry 
direction. The symmetry of the controlled dynamics causes 
difficulties in solving the necessary conditions for optimality. 
A simple numerical approach is presented to overcome this 
numerical ill-conditioning. 

This paper is organized as follows. In Section UTI a 3D 
pendulum is presented as a model of rigid body attitude dy- 
namics, and the symmetry of the 3D pendulum is described. 
An optimal control problem with symmetry is studied in 
Section |ni| and numerical results are given in Section |IV| 

II. Dynamics of a 3D Pendulum 

A 3D pendulum is a rigid body supported by a fixed 
frictionless pivot acting under the influence of uniform 
gravitational field [9]. We use a 3D pendulum model to 
study the optimal control for attitude dynamics of a rigid 
body, since it has three degrees of rotational freedom, and the 
gravitational potential has a symmetry: it is invariant under 
a rotation about the gravity direction. 

In this section, the continuous equations of motion are pre- 
sented. The symmetry of the 3D pendulum are discussed, and 
the control input structure is described. Discrete equations of 
motion, referred to as a Lie group variational integrator, are 
described for a controlled 3D pendulum model. 

A. Continuous equations of motion 

The configuration space of the 3D pendulum is SO (3). 
We identify the tangent bundle TSO(3) with SO(3) x so(3) 
by left translation, and we identify so (3) with M 3 by an 
isomorphism S(-) : M 3 i— > SO (3) defined by the condition 
that S(x)y = x x y for any x,y £ R 3 . We denote the attitude 
and the angular velocity of the rigid body as (R,Q) G 
T jR SO(3). The rotation matrix R G SO (3) transforms a 



vector represented in the body fixed frame to one represented 
in the inertial frame. 

Let p G R 3 be a vector from the pivot point to the mass 
center of the rigid body expressed in the body fixed frame, 
and let m, g G M and J G R 3x3 be the mass of the rigid body, 
the gravitational acceleration, and the moment of inertia 
matrix of the rigid body about the pivot point, respectively. 
The Lagrangian of the 3D pendulum L : TSO(3) i— > R is 
given by 

L(R,Q) = ^tr[S(n)J d S(n) T ] ^mge^Rp, 

where Jd G R 3x3 is a nonstandard moment of inertia 
defined by Jd = |tr[J] / 3X 3 — J, and we set the gravitational 
direction in the inertial frame as = [0; 0; 1] G § 2 . 

The continuous equations, derived from the Lagrange- 
d'Alembert principle, are given by 

ri + ft x n = mgp x R T e 3 + M, (1) 
R = RS(ft), (2) 

where II = J ft G R 3 is the angular momentum in the body 
fixed frame, and M G R 3 is the external control moment. 

B. Symmetry of 3D pendulum 

The kinetic energy of the rigid body is left invariant 
on TSO(3), and the gravitational potential energy is in- 
variant under a rotation about the gravity direction, which 
can be represented by the left action of the subgroup 
{expS(0e 3 ) GSO(3)|(9G§ 1 }. 

As a result, the Lagrangian of the 3D pendulum has a 
symmetry action by §\ § e : S 1 x SO(3) h-> SO(3) given by 

$e(R) = expS(0e 3 )#, 

for G S 1 . It can be shown that %L(R, ft) = L(R, ft). 

Suppose that there is no external control input. Noether's 
theorem states that a symmetry in the Lagrangian yields 
conservation of the momentum map. For the 3D pendulum, 
the momentum map of the symmetry action <£><9 corresponds 
to the inertial angular momentum of the rigid body about the 
gravity direction tts = e^RJft G R. It is conserved for the 
free dynamics of the 3D pendulum. 

The structure of the control input respects the symmetry of 
the uncontrolled free dynamics of the 3D pendulum, namely 

M = R T e 3 x u, 

for a control parameter u G R 3 . Since the external control 
moment has no component along the gravity direction, 
the angular momentum about the gravity direction is also 
preserved in the controlled dynamics. Such control inputs are 
physically utilized by actuation mechanisms, such as point 
mass actuators, that change the center of mass of the 3D 
pendulum. 

Here we introduce the concept of a geometric phase, 
and it is used to interpret the numerical optimization result 
in Section |IV| Using the symmetry, the dynamics of the 
3D pendulum can be expressed in terms of Y = R T e% 
in the reduced configuration space SO(3)/S 1 ~ S 2 . The 



corresponding flow in the original configuration space is 
reconstructed by lifting to a level set of the conserved 
quantity. Suppose that the trajectory in the reduced space 
is a closed loop, i.e. T(0) = T(T) for some T > 0, and the 
value of the angular momentum about the gravity direction 
is zero. Then, the terminal attitude is related to the initial 
attitude by a symmetric action. More explicitly, we have 

R(T) = * 8tM (R(0)), 
where # geo is the geometric phase determined by 

_ piurf-tifj] (r T JD 
tfgeo — (r T jr) 2 

where B is a surface in § 2 whose boundary is 
{T(t)\te [0,T]} [10]. Note that the geometric phase is 
determined only by the reduced trajectory of T and the 
characteristics of the rigid body J. It is independent of the 
velocity T. 

C. Lie group variational integrator 

The attitude of the 3D pendulum is represented by a 
rotation matrix R G SO (3). The conserved quantity, arising 
from symmetry, is emphasized in this study. However, the 
most common numerical integration methods, including the 
widely used Runge-Kutta schemes, neither preserve the Lie 
group structure nor first integrals. In addition, standard 
Runge-Kutta methods fail to capture the energy dissipation 
of a controlled system accurately [11]. For example, if we 
integrate © by a typical Runge-Kutta scheme, the quantity 
R T R inevitably drifts from the identity matrix as the simu- 
lation time increases. It is often proposed to parameterize 
(0 by Euler angles or unit quaternions. However, Euler 
angles are not global expressions of the attitude since they 
have associated singularities. Unit quaternions do not exhibit 
singularities, but are constrained to lie on the unit three- 
sphere S 3 , and general numerical integration methods do not 
preserve the unit length constraint. Therefore, quaternions 
have the same numerical drift problem. Renormalizing the 
quaternion vector at each step tends to break other con- 
servation properties. Furthermore, unit quaternions, which 
are diffeomorphic to SU(2), double cover SO(3). So there 
are inevitable ambiguities in expressing the attitude using 
quaternions. 

In [2], Lie group variational integrators are introduced by 
explicitly adopting the approach of Lie group methods [12] 
to the discrete variational principle [11]. They have the 
desirable property that they are symplectic and momentum 
preserving, and they exhibit good energy behavior for an 
exponentially long time period. They also preserve the Lie 
group structure without the use of local charts, reprojection, 
or constraints. 

Using the results in [2], a Lie group variational integrator 
on SO (3) is given for the 3D pendulum by 

hS(U k ) =F k J d - J d Ff, (4) 

Rk+l = RkFk, (5) 



n. 



fe+i 



hmgp x Rl +1 e 3 + hRl +1 e 3 x u k +i, 



R%=R k + eR k S(Ck) + 0(e 2 ), 



(9) 



(6) 

where the subscript k denotes the kth discrete variable for 
a fixed integration step size ftGl, and F k G SO (3) is the 
relative attitude between two adjacent integration steps. For 
a given (R k , ilfc) and control inputs, © is solved to find 
Then (i2fc+i, n^+i) is obtained by and ©. This yields a 
map (i?^, U k ) i— > IIfc + i) and this process is repeated. 

The only implicit part is ©. The actual computation of F k is 
done in the Lie algebra 50 (3) of dimension 3, and the rotation 
matrices are updated by multiplication. So this approach is 
distinguished from integration of the kinematics equation 
(13, and there is no excessive computational burden. The 
properties of these discrete equations of motion are discussed 
more explicitly in [2], [3]. We use these discrete equations of 
motion to formulate the following optimal control problem. 

III. Optimal control with symmetry 

We formulate an optimal attitude control problem for 
a 3D pendulum with symmetry. Necessary conditions for 
optimality are developed and computational approaches are 
presented to solve the corresponding two point boundary 
value problem. 

A. Problem formulation 

A discrete time optimal control problem is formulated as 
a maneuver of the rigid pendulum body from a given initial 
attitude Rq G SO (3) and an initial angular momentum IIo G 
M 3 to a desired terminal attitude Rfj G SO (3) and a terminal 
angular momentum IT^ G M 3 during a given maneuver time 
N. The performance index is the square of the I2 norm of 
the control inputs: 

given: (iJo,n ), (i&,n&), AT, 

N-l h 

min J= IK+iH 2 ' 

k=0 

such that R N = R%, U N = IT* 



subject to 0, Q and (|6|). 



B. Necessary conditions of optimality 

Variational models: The necessary conditions of opti- 
mality are developed using the standard variational approach. 
We first derive certain variational formulas. The variation of 
Rk G SO (3) can be expressed in terms of a Lie algebra 
element S(( k ) G 50 (3) for ( k G M 3 and the exponential map 
as 

R% = R k exp 65(a). 
The corresponding infinitesimal variation is given by 

d 



SR k 



de 



R k expeS(( k ) = R k S(( k ) 



(7) 



e=0 



This gives an expression for the infinitesimal variation of a 
Lie group element in terms of its Lie algebra. Then, small 
perturbations from a given trajectory can be written as 



where SU k Xk are considered as elements of R 3 . 

We derive expressions for the constrained variation of F k 
using its definition (|5j) and the variation of the rotation matrix 
Since F k = R^R k +i, the infinitesimal variation SF k is 
given by 

SF k — 5R^R k +i + RfrSRk+i, 
= -S(( k )F k + F k S(( k + 1 ). 

We can also write 5F k = F k S(^ k ) for £ k G R 3 using (Q. 
Using the property S(R T x) = R T S(x)R for any R G SO(3) 
and x G M 3 , we obtain the constrained variation of F k as 



ik = -F k Ck + Cfc+i- 



(10) 



We now relate the constrained variation of 5I\. k to £ k by 
starting with ©. Taking a variation of ©, we obtain 

hS(SU k ) = F k S(£ k )J d + J d S(^ k )F^. 

Using the properties, S(Rx) = RS(x)R T and S(x)A + 
A T S(x) = 5({tr[A] I 3x3 -A}x) for any x G M 3 , A G 
R 3x3 , and R G SO (3), the above equation is rewritten as 

hS(SU k ) = S(MF k J d ] I 3x3 - F k J d } F k £ k ). 

Thus, £fc is given by 

6 = ^ T {tr[F fe J d ]/ 3 x3-^J4" 1 = MIfc, (11) 

where B G M 3x3 . 

Necessary conditions: Define an augmented perfor- 
mance index as 



U% = U k + eSU k , 



(8) 



Ja = ^^IK+iir + K' S~ (logm(Fk - RlRk+i)) 

k=0 

+ \l T {-n fc+ i + Fjn fc + hmgp x i# +1 e 3 } 
+ A^' T {^ +1 e 3 x^ +1 }, (12) 

where A J., A| G M 3 , are Lagrange multipliers corresponding 
to the discrete equations of motion ^ and ©. The constraint 
© is applied implicitly by (1771 when taking the variation. 

Using the variational models i8l-fTTt. and the fact that 
the variations ( k: SU k vanish at k = 0, N, the infinitesimal 
variation of the augmented performance index is written as 

N-l 

SJ a = h6u k K ~ FL T k e 3 x 

k=l 

+ Ck {-Afc-i + + Cl\\ - hF k u k+1 elR k+1 } 

+ SUl {-A*_i + B T k \\ + V T k \\ - hB T k u k+1 elR k+1 ), 

where 

A k = F£, 

B k = hFl {tr[F fe J d ] / 3X 3 - F k J d }~ 1 , 

C k = hmgS(p)S(Rl +1 e 3 )F k T , 

V k = F fe T + 5(F fc T n fe )B fe + hmgS(p)S(Rl +1 e 3 )B k . 



Since 8J a = for all variations of SukXk^Hk, the 
expressions in the braces of the above equation are zero. Thus 
we obtain necessary conditions for optimality as follows. 



FkJd — Jd^k \ 



n, 



■fe+i 



hS(U k ) 

Rk+l = RkFk, 

hmgp x Rj +1 ez 



(13) 
(14) 



hRl +1 e 3 x uk+i, 







A. 





A T 

^k+l 
°k+l 



Uk+l = Rk+l e 3 X ^fej 

hFk+iUk+2£3 Rk+2 



hBl Jrl u k+2 elRk+2 



\ i 

A /c+l 
A /c+l 



(15) 
(16) 

i 
i 

(17) 

In the above equations, the implicit parts are (TT3t and fT7b . 
For a given initial condition (.Ro? n , Aj, Aq), we can find 
F by solving JT5I . Then, Ri is obtained by (Tl4l . Since 

= i?f e3 x Aq by dT6l . Ill can be obtained using (TT5l . We 
solve (TT3l to obtain F\ using IIi. Finally, A}, X\ are obtained 
by solving the implicit equation (H71 . since A\,B\,C\,V\ 
are functions of IIi, Fi. 

The implicit equation (IT3l is solved by Netwon's iteration 
in the Lie algebra, and the implicit equation (fT7l is solved by 
fixed point iteration. Numerical computations show that two 
or three iterations are typically required to achieve machine 
precision. 

C. Two point boundary value problem 

The necessary conditions for optimality are given by a 
12 dimensional two point boundary value problem. This 
problem is to find the optimal discrete flow, multipliers, 
and control inputs to satisfy the equations of motion dT3l- 
(IT5l . optimality condition dT6l . multiplier equations dTTl . and 
boundary conditions simultaneously. 

We substitute the optimality condition dT6l into the equa- 
tions of motion and the multiplier equations, and we apply 
the shooting method to solve the two point boundary value 
problem using sensitivity derivatives. The shooting method is 
numerically efficient in the sense that the number of iteration 
parameters is minimized; 6 elements of the initial Lagrange 
multiplier are iterated. In other approaches, the entire discrete 
trajectory of the control input and Lagrange multiplier are 
updated. 

The drawback of the shooting method is that the extremal 
solutions are sensitive to small changes in the unspecified 
initial multiplier values. The nonlinearity makes it hard to 
construct an accurate estimate of sensitivity. In addition 
this problem, the symmetry and the underactuation induce 
numerical ill-conditioning. Therefore, in order to apply the 
shooting method, it is important to compute the sensitivities 
accurately, and the effects of the symmetry should be taken 
into account. 

In this paper, the attitude dynamics of a rigid body is 
described by the structure-preserving Lie group variational 
integrator, and the sensitivity is expressed in terms of a 
Lie algebra element. This approach completely avoids any 
singularity in the attitude representation, and the discrete 
flow respects the geometric features. The resulting sensitivity 



derivatives are sufficiently accurate for the shooting method. 
Furthermore, a simple numerical approach is presented to 
eliminate the ill-conditioning caused by the symmetry. 

Sensitivity derivatives: Taking a variation of the discrete 
equations of motion and the multiplier equation using the 
variational models, the linearized equations of motion and 
the linearized multiplier equations can be written as 



4fe+i*fc+i + (4+i) *A fc+ i, 



3x6 



Xk+1 

sx k 

where x k = [C k ;SU k ] G M 6 , and matrices A ij G K w ~ w are 
suitably defined. The solution of the linear equations is given 
by 

"^11 ^12" 
^21 ^22 



X N 



x 
SXo 



where G IR 6x6 . For the given two point boundary value 
problem, the initial attitude and the initial angular momentum 
are fixed, and the terminal multiplier is free. Thus, we have 
the following sensitivity equation for the terminal attitude 
and the terminal angular momentum with respect to the initial 
multiplier; 



x N = yfr L2 5\ . 



(18) 



Avoiding numerical ill-conditioning: The symmetry 
yields a conserved quantity by Noether's theorem, and it 
causes a fundamental singularity in the sensitivity derivatives 
for the two point boundary value problem. At each iteration, 
we require the inverse of the sensitivity derivative represented 
by the matrix \I/ 12 to update the initial multiplier to satisfy 
the terminal boundary condition. However, this sensitivity 
matrix has a theoretical rank deficiency of one since the 
vertical component of the inertial angular momentum is con- 
served regardless of the initial multiplier variation. Therefore, 
equation (TT8l is numerically ill-conditioned. 

Here we presents a simple numerical scheme to avoid 
the numerical ill-conditioning caused by the symmetry. We 
decompose the sensitivity derivative into symmetric parts and 
asymmetric parts. Equation (TTsl is rewritten as 



(19) 









*2 




~5\h' 


sn N 




*3 


*4 







where G R 3x3 are submatrices of \I/ 12 . Using the above 
equation and 0, the infinitesimal variation of the inertial 
angular momentum is given by 

Sttn — S(Rn^-n) = SRn^n + RjySTL n , 
= —RnS(Hn)(n + RjsfSTl]\[ , 
= -R N S(U N )(^ 1 X 1 + * 2 X 2 ) + R N (*3\l + ^A 2 ,). 

Now, the sensitivity derivative equation (TT9t can be rewritten 
in terms of the inertial angular momentum variation as 



'Cn' 




_Sn N _ 





*1 

i?Ar(*3-5(njv)*i) R N {^ 4 



*2 

-s(n N )9 2 ) 

(20) 



6, 



From the symmetry, the third component of the inertial 
angular momentum variation is zero; S(ttn)3 = 0. Thus, the 
sixth row of the above matrix is zero. (Numerical simulation 
in the later section shows that the norm of the last row of the 
transformed sensitivity matrix is at the level of 10 -15 .) Now, 
we find an update of the initial multiplier by the pseudo- 
inverse of the 5 x 6 matrix; 



6\ = ^x' N = ~ T (~~ T )- 1 x> N , 



(21) 



where S £ 



5x6 



is composed of the first five rows of 



the transformed sensitivity derivative in d20l . and x' N = 
[Cat; 5(ttjv)i; 5(7rjv)2] £ This approach removes the sin- 
gularity in the sensitivity derivatives completely, and the re- 
sulting optimal control problem is no longer ill-conditioned. 
Numerical simulations show that the numerical optimization 
procedure fails without this modification. 

Newton iteration: Using the decomposed sensitivity, an 
initial guess of the unspecified initial conditions is iterated 
to satisfy the specified terminal boundary conditions in the 
limit. Any type of Newton iteration can be applied. We use 
a line search with backtracking algorithm, referred to as 
Newton- Armijo iteration [13]. The procedure is summarized 
as follows. 



1 

2 
3 
4 
5: 
6 
7 
8 
9 
10 
11 
12 
13 
14 
15 



N\ 



Guess an initial multiplier Ao- 
Find n fc , R k , \\,\ 2 k using O-O- 
Compute the terminal B.C. error; Error = Wx'j 
Set Error^ = Error, i = 1. 
while Error > 

Find a line search direction; D = E^. 

Set c = 1. 

while Error^ > (1 — 2ac) Error 

Choose a trial multiplier Aq = A + cDzn- 
Find R k , Aj[., \\ using O-O- 
Compute the error; Error^ = ||^||. 
Setc = c/10, z = i + l. 

end while 

Set Ao = Aq, Error = Error*, (accept the trial) 
end while 



Here i is the number of iterations, and cs,ol G M are 
stopping criterion and a scaling factor, respectively. The outer 
loop finds a search direction by computing the sensitivity 
derivatives, and the inner loop performs a line search to find 
the largest step size c G R along the search direction. The 
error in satisfaction of the terminal boundary condition is 
determined at each inner iteration. 

IV. Numerical Examples 

Numerical optimization results for the 3D pendulum are 
given. Two elliptical cylinders, shown in Fig. [I] are used as 
rigid pendulum models. The properties are chosen as 

Body (A): m = 1, J = diag[0.13, 0.28, 0.17], p = 0.3e 3 . 
Body (B): m = 1, J = diag[0.22, 0.23, 0.03], p = 0.4e 3 . 

Four cases are considered. Each maneuver is from a 
hanging equilibrium to another hanging equilibrium with 
a rotation about the vertical axis. The rotation angles are 



chosen as 90° and 180°. Since the vertical component 
of the angular momentum is set to zero, the rotation is 
purely caused by the geometric phase effect given in OJ). 
These problems are challenging in the sense that the desired 
maneuvers are rotations about the gravity direction, but the 
control input cannot directly generate any moment about the 
gravity direction. 

The corresponding boundary conditions are as follows. 

(i) Body (A), hanging equilibrium to hanging equilibrium 
with 90° yaw 



Ro 



'3x3, 



n = o 3 



Xl, 



IT 



N 





1 


o 3 > 



1 



(ii) Body (A), hanging equilibrium to hanging equilibrium 
with 180° yaw 



^0 — ^3x3 

no = o 3x i 



diag[-l,-l,l], 



IT 



N 



o 3> 



(iii) Body (B), hanging equilibrium to hanging equilibrium 
with 90° yaw 



Ro = I: 



3x3, 



R 



'N 



-1 

1 



o 3 



xl, 



IT 



N 



o 3> 



(iv) Body (B), hanging equilibrium to hanging equilibrium 
with 180° yaw 



Ro 



'3x3, 



i4 = diag[-l,-l,l], 



IIo = 03 X i, 11^ = 03x1. 



The optimal control results are given in Table Q] where 
the optimized performance index, the error in satisfaction of 
the terminal boundary condition, and the simulation running 
time are shown for each case. The terminal error is at the 
level of machine precision, and the simulation time is about 
5 minutes. 

Figures EHSI show snapshots of the attitude maneu- 
vers, reduced trajectory of V = R T es on a sphere, 
control input history, and convergence rate. (A simple 




(a) Body (A) 



I 



(b) Body (B) 



Fig. 1. Elliptical cylinder 



TABLE I 
Optimization results 



Case 


J 


logm(R d ^ T R N ) 








AT 


(i) 


5.91 


2.30 x 1(T 14 


1.34 x 1(T 14 


2.72 


(ii) 


7.32 


4.80 x 1(T 15 


1.66 x 1(T 14 


5.25 


(iii) 


1.73 


1.22 x 1(T 15 


6.55 x 1(T 14 


4.09 


(iv) 


3.37 


3.06 x 10- 14 


3.04 x 1(T 14 


5.05 



AT: Simulation running time in Intel Pentium M 740 
1.73GHz processor (min.) 



animation for the attitude maneuver can be seen at 
|http : / / www . umich . edu/ ~ tylee| ) 

The convergence rate figures show violation of the termi- 
nal boundary condition according to the number of iterations 
in a logarithm scale. Red circles denote outer iterations in 
Newton- Armijo iteration to compute the sensitivity deriva- 
tives. For all cases, the initial guesses of the unspecified 
initial multiplier are arbitrarily chosen. The error in satisfac- 
tion of the terminal boundary condition converges quickly 
to machine precision after the solution is close to the local 
minimum at around 50th iteration. These convergence results 
are consistent with the quadratic convergence rates expected 
of Newton methods with accurately computed gradients. The 
condition number of the decomposed sensitivity derivative 
given at (1241 varies from 10° to 10 5 . If the sensitivity 
derivative is not decomposed, then the condition numbers 
are at the level of 10 19 , and the numerical iterations fail. 

The numerical examples presented in this paper show 
excellent numerical convergence properties. This is because 
the proposed computational algorithms on SO(3)are geo- 
metrically exact and numerically accurate. In addition, the 
algorithm incorporates a modification that eliminates the 
singularity caused by the symmetry. 

We interpret the optimization results using the geometric 
phase formula given by ©. For given initial conditions, the 
vertical component of the initial angular momentum is zero. 
Thus, the rotation about the vertical axis is purely caused by 
the geometric phase. Since the geometric phase is determined 
by a surface integral on S 2 whose boundary is the reduced 
trajectory T, it is more efficient for the reduced trajectory to 
enclose the area at which the absolute value of the integrand 
of is maximized. 

In each subfigure (b) of Figures I2H3 me infinitesimal 
geometric phase per unit area is shown by color shading. The 
reduced trajectory, which represents the gravity direction in 
the body fixed frame, is shown by a solid line. The north 
pole of the sphere corresponds to the hanging equilibrium 
manifold, and the reduced trajectory starts and ends at the 
same north pole for the given boundary conditions. 

Comparing Figures 2(b), 3(b) with Figure 4(b), 5(b), it can 
be seen that Body (A) and Body (B) have different geometric 
phase characteristics. This is caused by the fact that the 
geometric phase depends on the moment of inertia of the 
body. For Body (A), the absolute value of the infinitesimal 



geometric phase is maximized at a point on the equator, and 
for Body (B), it is maximized at the north pole. We see that 
the optimized reduced trajectories try to enclose those points. 

As a result, the optimized attitude maneuver of Body (A) is 
distinguished from that of Body (B). The attitude maneuver 
of Body (A) is relatively more aggressive than that of Body 
(B) since the reduced trajectory passes near the equator 
corresponding to a horizontal position. Body (B) does not 
have to move far away from the hanging equilibrium since 
the infinitesimal geometric phase is maximized at that point. 
The resulting attitude maneuver is relatively benign. 
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Fig. 2. (i) Body A, hanging equilibrium to hanging equilibrium with 90° 
yaw 




(a) Attitude Maneuver (b) Geometric Phase 




t Iteration 



(c) Control Input (d) Convergence Rate 



Fig. 4. (iii). Body B, hanging equilibrium to hanging equilibrium with 
90° yaw 
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Fig. 3. (ii). Body A, hanging equilibrium to hanging equilibrium with 
180° yaw 
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Fig. 5. (iv). Body B, hanging equilibrium to hanging equilibrium with 
180° yaw 



